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Abstract 

Using dynamic models of tensegrity structures, we derive provable, distributed control laws 
for stabilizing and changing the shape of a formation of vehicles in the plane. Tensegrity 
models define the desired, controlled, multi-vehicle system dynamics, where each node in the 
tensegrity structure maps to a vehicle and each interconnecting strut or cable in the structure 
maps to a virtual interconnection between vehicles. Our method provides a smooth map from 
any desired planar formation shape to a planar tensegrity structure. The stabilizing vehicle 
formation shape control laws are then given by the forces between nodes in the corresponding 
tensegrity model. The smooth map makes possible provably well behaved changes of formation 
shape over a prescribed time interval. A designed path in shape space is mapped to a path in 
the parametrized space of tensegrity structures and the vehicle formation tracks this path with 
forces derived from the time-varying tensegrity model. By means of examples, we illustrate the 
influence of design parameters on performance measures. 

1 Introduction 

Recent efforts in coordinated control have focused on reconfigurable mobile sensor networks 
with application to collective sensing and monitoring on land, in the sea, in the air and in space. 
Each sensor platform in the network is a vehicle; therefore, the spatial distribution of the vehi- 
cles determines the geometry and resolution of the sensor array. Control over the geometry and 
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resolution of the vehicle formation, also referred to as the "shape" of the formation, can provide 
important advantages to performance and efficiency of data gathering and processing. For exam- 
ple, in searching and tracking tasks, it can be critical to have the network estimate gradients and 
possibly higher-order derivatives from noisy measurements of the sampled field. To minimize the 
error in these estimates, the shape of the formation should adapt to changes in the environment 
and the motion of the network. Zhang and Leonard presented an algorithm for level set tracking 
where the shape of the group was determined so as to minimize the least mean square error in 
gradient estimates of a scalar field [Ij. More generally, shape control plays an important role in 
multi-scale sensing tasks where changes are desired that require shifts in resolution for some or 
all of the network. Shape control can be significant in other vehicle network tasks, for example, 
when vehicles coordinate their activity to escort, carry or otherwise interact with objects in their 
environment. 

The shape of a vehicle formation depends only on relative measurements among individuals, 
i.e., it describes the way the individual vehicles are arranged relative to one another rather than 
where the group is or how it is oriented. Accordingly, shape control can naturally be distributed. 
In this paper, we propose a methodology that systematizes the design and analysis of distributed 
shape control of a group of vehicles in the plane. 

Our approach is to synthesize and analyze shape dynamics of a group using models of tensegrity 
structures, which are spatial networks of interconnected struts, cables and rods [2l[3llll|5]. The goal 
is to design control laws that drive vehicle formations into shapes with forces that can be represented 
as those internal to tensegrity structures. We extend the concept to control the formation along 
a smooth path in shape space consisting of tensegrity structures; this allows for stable, smooth 
reconfiguration of the group shape. 

The artist Kenneth Snelson [2] built the first tensegrity structure, and Buckminster Fuller [3] 
coined the term "tensegrity" by combining the words "tension" and "integrity". Tensegrity struc- 
tures have since been extensively studied in the engineering, mathematics and even the biology 
literatures; see j6] and references therein for a history and survey of tensegrity research. In the 
mathematics literature, Connelly, Whiteley and others have studied and proved conditions for sta- 
bility and rigidity properties of tensegrities (sometimes referred to in the mathematical formulation 
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as tensegrity frameworks) [H El El |9] . These properties help motivate our approach since modehng 
a multi-agent network as a tensegrity suggests that the vehicle network will inherit the same useful 
properties as the tensegrity. In the engineering literature, researchers have studied both statics 
and dynamics of tensegrity structures, e.g., in |10|lll]. and have explored numerous possibilities for 
tensegrity structures including both passively and actively controlled structures, e.g., in |12| [T3] . 
Skelton et al |4] define the "small control energy principle" arguing that the shape of a tensegrity 
structure can be changed with little control energy; their method involves changing the physical 
parameters of the structure so that with little effort the shape of the structure changes to the new 
corresponding equilibrium. Our approach to shape change similarly makes the desired shape a new 
equilibrium for the system. In |14j the authors study symmetrical motions for reconfiguration of a 
class of tensegrity structures composed of six bars, a rigid top and base and eighteen tendons. 

The tensegrity structures we consider are formed by a combination of struts (connecting ele- 
ments in compression) and cables (connecting elements in tension), which we classify together more 
generally as edges. These edges meet at nodes. A significant challenge in the tensegrity literature 
has been solving the form finding problem: determining the shape of the tensegrity, given a number 
of nodes and edges [15]. For the "reverse engineering" problem, i.e., determining a model and a set 
of edges, given a desired shape, Connelly has proven a result that provides a means to systemati- 
cally design stable planar tensegrities in the shape of any strictly convex polygon [5^. The method 
developed by Connelly is inductive (i.e., a tensegrity with N nodes is constructed from a tensegrity 
with — 1 nodes) and yields structures that almost never require all-to-all coupling topologies. In 
the present paper, we develop an alternative systematic method to define a tensegrity model that 
realizes any given arbitrary planar shape that is convex or non-convex, at the cost, however, of often 
requiring connecting topologies closer to all-to-all coupling. Our method also has the advantage of 
providing a mapping from shape to tensegrity that is smooth with respect to shape parameters. 

Using an energy approach, Connelly developed a model of the forces and formalized the notion 
of stability of a tensegrity 13 [71 [8] • In his model it is assumed that cables do not increase in 
length and struts do not decrease in length. The tensegrities we design to model a vehicle network 
are virtual since the vehicles are not physically connected. Accordingly, these constraints that are 
reasonable in the physical setting have to be relaxed in the virtual setting, since restrictions on 
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cable and strut length changes cannot be imposed as a constraint on the distances between pairs 
of vehicles that are not physically connected. In the absence of the cable and strut length change 
constraints, the model from [5_, which uses linear springs to represent cables and struts, allows for 
arbitrary stretching and shrinking of a tensegrity in the plane. We therefore augment the model 
with the relaxed constraints in order to isolate planar tensegrities. We then present a systematic 
and smooth method to compute the parameters of the augmented model that realizes a tensegrity 
structure for any arbitrary desired shape in the plane. 

To make our mapping from shape to tensegrity relevant for vehicle network control, we define 
the following mapping between the vehicle network and a tensegrity structure: each node of the 
tensegrity structure is identified with one vehicle of the network and the edges of the structure 
correspond to communication and control force directions between the vehicles. If an edge is a 
cable, the force is attractive; if the edge is a strut then the force is repulsive. The magnitude 
of the force depends on the tensegrity parameters and the relative distance between the vehicles 
associated with the edge. The dynamics of the tensegrity nodes are derived assuming a point-mass 
double integrator model for each networked vehicle. The point-mass model may appear somewhat 
simplistic since it seems to ignore the challenges of controlling the detailed dynamics of each of the 
individual vehicles. However, for practical implementations such as the coordinated control of a 
network of autonomous underwater gliders for adaptive ocean sampling, as described in [16], it is 
useful to decouple the design of the coordinating control strategy from the lower-level, individual- 
based tracking control. 

Using the mapping we derive between shape and tensegrity and the mapping we define between 
tensegrity and vehicle network, we prove that the tensegrity model provides control forces that 
stabilize a network of N vehicles to a desired shape. We extend this approach to stable, smooth 
vehicle network shape change control; the method finds and tracks a smooth path in the space of 
tensegrities (equivalently the space of shapes) that connects prescribed initial and final shapes. 

In Section[2]we present models of tensegrity including our augmented model to isolate tensegrity 
shapes without constraining edge lengths. We then derive a smooth map from arbitrary planar 
shape to planar tensegrity. In Section [3] we prove stability of the desired shape for the dynamics of 
the vehicle network represented as a tensegrity. We prove and illustrate our method for controlling 
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change of shape of the network in Section [4j We make final remarks in Section [Sj 



2 Tensegrity Models and Mapping Arbitrary Shape to Tensegrity 

2.1 Shape equilibrium conditions for model with edge length constraints 

We investigate in this section the modehng of forces induced by the two types of edges of a 
tensegrity structm'e as developed by Connelly in [5 . With this model and physical constraints 
imposed on the lengths of struts and cables, Connelly has proven a theorem that provides a means 
to systematically design stable planar tensegrities that correspond to strictly convex polygons [5]. 
As a first step to developing our systematic and smooth method for designing planar tensegrities 
to realize arbitrary shapes, we first examine the equilibrium conditions for Connelly's dynamic 
model. Using algebraic graph theory, we formally derive the conditions on allocation of cables and 
struts and choice of model parameters that must be satisfied for a given shape to be an equilibrium 
of the dynamic model. We show that in the absence of the cable and strut length constraints, 
this simple model, which uses linear springs to represent cables and struts, has a continuum of 
equilibria allowing arbitrary stretching of a tensegrity in the plane. Hence in our virtual setting, 
where physical constraints on the edges cannot be imposed, the linear model does not produce an 
isolated equilibrium as we desire; in particular, the model cannot be used to control the scale of 



the group shape. In Section 2.2 we augment the model to isolate shapes of prescribed scale. 

The edges of a tensegrity structure are modeled as linear springs with zero rest length. Cables 
have a positive spring constant while struts have a negative one [5l [7]. Hence for two nodes i,j we 
have 

fi^j = ^ijiQi - Qj) = -fj^ii (1) 

where fi^j G is the force applied to node j as a result of the presence of node i, qi = {xi,yi) G 
is the position vector of node i, and coij is the spring constant of the edge ij. The spring constant 
LVij is negative if ij is a strut, positive if ij is a cable, and zero if there is no connection between the 
nodes i and j; uJij is called the stress of the edge ij. For a tensegrity structure with nodes, its 

iV(JV-l) 

weighted interconnection topology can be described by the vector uj € M 2 , where components 
consist of the stresses cuij. If the vector u has no zero elements, then the associated interconnection 



graph is complete, i.e., there is an edge between every pair of nodes. A given shape can be realized 

with different sets of edges, notably those with incomplete graphs. 

Shape refers to the way the nodes are arranged relative to one another rather than where the 

structure is or how it is oriented. Thus, a given shape can be associated with different sets of 

absolute position vectors. Let x = (xi, . . . ,xn)'^ and y = (yi, . . . , un)'^ , then a placement, defined 
/_.\ 

G M^^, characterizes the tensegrity in absolute coordinates (for convenience we will 



as q 



X 



V) 



N 

write q = (x, y)). Let qc = Qi ^'e the centroid of the tensegrity. For two placements 

i=l 

qi g ]^2JV g^j-^j q2 g i^2Af^ define the equivalence relation TZ as 



q^TZq^ <^=^ 3{R,i) G SE{2) and q^ = (q"^ after rigid rotation about by R and translation by i). 

An element of SE{2) is a rigid motion and so any two placements in the same equivalence class 
IZ have the same shape. We can therefore identify a given shape with the equivalence class [q^] = 
{q G M^^ I q^7^q}, where q^ is a representative placement with the given shape. The class [q ] 
can be identified with SE{2). We note that the ordering of the nodes in the placement matters 
to shape classification since two placements q^ and q^ representing the same geometric shape but 
with nodes permuted will not be in the same equivalence class. 

Using the force model ([T]), we derive the equations of motion for each node of a tensegrity with 
placement q. The potential energy of a tensegrity structure, with the forces induced by its edges 
as modeled by ([T|, is 

^ N N 



i=l j=i+l 

N N n 

In the sequel we write ^ to represent ^ ^ . The potential (2) increases as we stretch the 

i<j i=lj=i+l 

cables and shrink the struts. We introduce in the system a linear damping force of the form —vqi, 
where > is a damping coefficient. The Euler-Lagrange equations of motion for the nodes of the 
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tensegrity structure using Cartesian coordinates in the plane are 



Xi=Pi 



V 



■V 

Pi 



V 

-vpl 



dV 

dxi 

dV 

dyi 



N 

-^Pi - ^t^iiCa^i - Xj) 

N 

-up( -^ujij[yi-yj) 



(3) 



z = 1, . . . , A^, where pf and p( are the respective momenta in the x and the y directions, assuming 
unit mass for each particle. For this system, the configuration space is Q = and q G Q; an 
element in the cotangent bundle z G T*Q can be written as z = (q, p) = ((x, y), (p^, p^)), where 
p^ = (pf, ■■■,Pn) and p?^ = (pf , . . . 

Our goal is to solve for and stabilize an arbitrary tensegrity structure corresponding to a desired 
shape given by [q*^] . The first step is to find the stresses LOij that make a given [q*^] an equilibrium 
shape of the system. Recall that uoij = implies that nodes i and j are not connected, z"^ is an 
equilibrium of Q if and only if p^ = p^ = and q*^ = (x'^,y'^) is a critical point of the potential 
y(q). Since V^(q) depends only on relative positions of nodes, then q*^ is an equilibrium shape if 
and only if every q G [q^] is an equilibrium shape. Let [z^] = ([q^], 0, 0), then z*^ is an equilibrium 
of ([3]) if an only if every z G [2^] is an equilibrium of ^ . 

We now rewrite (H to find a more exploitable relationship between the stresses uJij and the 
critical points of V^(q). Using notations from algebraic graph theory, we consider a tensegrity 
structure as an undirected graph G = {V,£), where V is the set of nodes and £ the set of edges. 
Let dj be the degree of node j (the number of edges at node j), then the Laplacian L of the graph 
G is the N X N matrix defined by 



L. 



dj if i = j 
-1 if{i,j)e£ 
otherwise. 



(4) 



In our setting, interconnection strengths are not identical from one edge to the other but rather are 
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weighted by the spring constants uJij. A tensegrity structure can then be viewed as an undirected 
graph for which we define the weighted pseudo Laplacian O by 



( N 

UJij if « = j 
-UJij if i / j. 



This matrix is called the stress matrix by Connelly [5] . The stress matrix is an A'" x A'" symmetric 
matrix, and the A-dimensional vector 1 = (1, . . . , 1)"^ is in the kernel of (this last property being 
true for all Laplacians). 

The potential Q can be rewritten as 

y(q) = ^q^(17 /2)q, (5) 



where I2 is the 2x2 identity matrix and 0, I2 is the 2n x 2n block diagonal matrix 



n 
n 

allows us to derive a simple relationship between the choice of 
stresses Wjj and the equilibria of the model. The critical points of ([5| and hence the equilibria q*^ 
of ([3]) satisfy 

q^(n ® h) = 0. (6) 

Since the stress matrix is symmetric, a placement q^ = (x'^,y'^) is a critical point of T^(q) if and 
only if and y"^ are each in the kernel of $7. Recall that 1 is in the kernel of Assuming that the 
nodes are not all in a line, x^,y^ and 1 are linearly independent. We can conclude that with this 
model, a combination of cables and struts will have an equilibrium if and only if rank(O) < A^ — 3. 
We assume from now on that A > 4. 

By choosing the stresses of the edges of the structure so that rank(r2) = A — 3, the kernel of the 



stress matrix is exactly three dimensional. We derive a method in Section 2.2 to compute 17 that 
fixes the desired shape of the equilibrium. However, the computed O will not fix the scale of the 
equilibrium configuration for the model (|3]). Indeed if ker(r2) = spanjx*^, y^, 1} then (ax"^, /Jy*^, 0, 0) 
is also an equilibrium Va, /5 G M. For real tensegrities this is not a problem because the cable and 
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strut constraints preclude the existence of any but the original equilibrium. In the virtual setting, 
however, where the same constraints cannot be imposed, we get a continuum of equilibria, which 
is not desirable. For example, if the prescribed shape for the tensegrity is a square, it will be the 
case that not only all squares but also all rectangles will be equilibria. 

In order to use tensegrity structures in our virtual setting, we need to modify this model to 
isolate equilibria. In the next section we propose an augmented force model and show that an 
equilibrium shape (geometry and scale) is isolated. We design the augmented model so that we 
can still make use of equation ([6|, derived using the model ([T|, that determines the geometry of 
the tensegrity as a function of the parameters totj . 

2.2 Augmented model and smooth mapping from arbitrary shape to tensegrity 

In the previous section we modeled edges as springs with zero rest length. Because in our virtual 
setting it is not possible to impose physical constraints on the edges, this model yields a continuum 
of equilibrium shapes for the system ([3|, fixing only the geometry of the structure but not its scale. 
We now present an augmented model that allows us to isolate the shape geometry and scale. We 
then derive a systematic and smooth method that prescribes tensegrity edge allocations and model 
parameters so that an arbitrary desired planar shape is an isolated equilibrium of the tensegrity 
dynamics. In Section [3] we prove that the desired shape is an exponentially stable equilibrium of 
the tensegrity dynamics so that a vehicle network with control forces simulating forces internal to 
the derived tensegrity structure will converge exponentially to the desired shape. 

In the augmented model, edges are modeled as springs with finite, nonzero rest length. An edge 
is a cable when it is longer than its rest length, i.e., in tension; an edge is a strut when it is shorter 
than its rest length, i.e., in compression. For two nodes i,j we define 

fi^j = aijUJij'^ ^(^i - qj) = -fj^i- (7) 

Here rij = \\qi — qj\\ is the relative distance between nodes i and j, lij > is the rest length of 
the spring that models the edge ij, ujij is the spring constant from model ([T|, and Qjj is a scalar 
parameter that fixes the spring constant of model M for the edge ij. 
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We derive for this model an analogue of the stress matrix $7. The potential energy of a tensegrity 
structure with the forces induced by its edges modeled by ([7| is 



^^(q) = \Y1 ^ii^ij^^ii - hf- 
i<j 

With the same damping force used in the previous section, the equations of motion are 



(8) 



Xi =Pi 



V 

Vi = Pi 



Pi = -m 



■V V 

Pi = -vpl 



dV 

dxi 

dV 
dyi 



N 

-^Pi - '^U}ji{Xi - Xj) 

i=i 

N 



(9) 



i = 1, . . . , N , where uJij is given by 



(10) 



As before, our goal is to solve for and stabilize a tensegrity structure corresponding to a desired 
shape [q*^] . First we compute the uJij so that [q*^] is an equilibrium shape of the system Q . This 
requires finding the relationship between the choice of the iVij, aij and /^'s and the equilibria of the 
system Since V^(q) depends only on relative positions of nodes, then q^ is an equilibrium shape 
if and only if every q G [q^] is an equilibrium shape. As in the previous model, is an equilibrium 
of ^ if and only if = = and = (x'^,y^) is a critical point of the potential V"(q). We 
likewise define [z^] = ([q'^],0,0), then is an equilibrium of ([9| if an only if every z G [z^] is an 
equilibrium of (pi). The critical points of ([8| are given by 



N 



li 



0, i = l,...,N. 



(11) 



From (11), an analogue of the stress matrix O is constructed. The new stress matrix is not a 



constant matrix and depends on the relative distances rj,- between pairs of nodes. The entries of 
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the new stress matrix are given by 



Oij(x,y) = < 



^ N _ 

-tJij(x,y) ifi/j, 



where the oJij is the new stress for the edge ij given by (10). The vector 1 is also in the kernel of 
V (x,y) E X M^. 

This new stress matrix can now be used to characterize the equilibria of ([9]). To make the 
placement q*^ = (x*^, y*^) a critical point of V^(q), we pick (if possible) the parameters aij,ujij, kj so 
that 

f^(x^y^)x^ = 

(12) 

O(x%y^)y^ = 0. 



As a first step we choose the parameters aij and lij for all i,j so that 0,{x.^,y'^) = 0,. In order to 
make u;jj(x^,y^) = LOij, we choose aij,lij sue 
[q*^] . This last equation is solved by picking 



make ojij{x.^,y^) = ujij, we choose aij,lij such that ajj(l — ^) = 1, where rfj is the value of rij at 



arctanwjo , , 

/ [ X (13) 

lij = rfj ll arctan u>. 



If edge ij is a strut, then cjjj < 0, and we have from equation (13) that Oij < which makes the 



spring constant aijtOij > and lij > rfj. If edge ij is a cable then iVij > 0, and we have from 
equation (13) that Oij > which makes the spring constant OijUJij > and lij < rfj. The choice of 



lij and Uij is not unique, but this choice makes the vector field (j9j) a C°° map of uJij and rfj. This 
result will be critical in Section |4] to prove stability for the time-varying control law that changes 
the shape of the formation from any initial shape to any final desired shape. 

We now show that the parameters coij can be found independently of parameters aij and lij, 
so that ker(J7) = spanjx*^, y^, 1}, and such that the nonzero eigenvalues of are all positive. 
This makes the equilibrium = (x'^,y^,0,0) an isolated minimum of the potential (modulo rigid 
transformations), i.e., our choices ensure that we have the right combination of struts and cables 
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to make = (x'^,y*^) (and therefore any q G [q*^]) a tensegrity structure. 17 is a symmetric 
matrix, hence it has only real eigenvalues and it can be diagonalized using an orthonormal basis. 
As mentioned previously, if the case when all the nodes are in a line is excluded, then x'^,y^ and 
1 are linearly independent. We can complete these three vectors with — 3 others and obtain a 
basis of M^. Then applying the Gram-Schmidt procedure to those vectors yields an orthonormal 
basis (vi, . . . , v^v) for that satisfies 

span{vi, V2, V3} = span{x'',y^, 1}. 

Now we define the N x N diagonal matrix D = diag(0, 0, 0, ^4, . . . , ^at), where di > 0, Vi G 
{4, • • • , N}, and the orthonormal N x N matrix A = (vi • • • v^v). If we compute ADA^ we have a 
symmetric positive semi-definite matrix with its kernel equal to spanjx*^, y*^, 1}. Setting 17 = ADA^ 
determines the values of stresses that make the desired shape [q*^] a tensegrity structure. We 
prove stability of this equilibrium shape in Section [3j 

The choice of eigenvalues D and eigenvectors A for the stress matrix is not unique. We inves- 
tigate next, through an example, the influence of the choice of the eigenvalues and eigenvectors of 
the stress matrix on the resulting interconnection topology that achieves the given desired shape. 

2.3 Example 

We illustrate here the computation of the stress matrix using the method developed in Section 



2.2 and examine resulting interconnection topologies. It is known that stable tensegrity structures 
with A^ nodes require at least 2 A — 2 edges [7] . Connelly has proven a result that provides a means 
to systematically design stable planar tensegrities in the shape of any strictly convex polygon [5] . 
His method is designed to yield tensegrity structures with minimal number of edges. Our method 
allows us to generate tensegrity structures of any shape, convex or non-convex, but often yields 
interconnection topologies with number of edges greater than the proven lower bound. However, 
as we illustrate , it is possible in our method to use the freedom of choice in the eigenvalues and 
eigenvectors of the stress matrix to reduce the number of edges. 
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Figure 1: Five node configuration given by x*^ = (2, 3, 4, 3, 1), = (2,1,2,5,4). The labels on the 
nodes define the ordering. 



Consider the network configuration given by 



X 



2 3 4 3 1 
2 12 5 4 



(14) 



and plotted in Figure[T} Following the method from Section 2.2 we take Di = diag(0, 0, 0, 1, 1) and 
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where the columns of Ai constitute a basis of orthonormal eigenvectors obtained with the Gram- 
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Schmidt procedure. The stress matrix fii = Ai^iA^ is given by 
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The tensegrity structure corresponding to this stress matrix, plotted in Figure has an inter- 
connection topology requiring 9 edges. To reduce the number of edges, we manipulate our choice 
of D and A so that 17 = ADA^ has entries identically equal to zero. Consider, for example, setting 



D2 = diag 
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We compute the stress matrix: 
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The tensegrity corresponding to this stress matrix, plotted in Figure |2|b) has an interconnection 
topology requiring only 8 = 2x5 — 2 edges. The number of edges cannot be reduced further since 
we have reached the lower bound proven in [7]. 

As the number of nodes increases, it becomes harder to systematically find a combination of 
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Figure 2: Tensegrity structures generated from the stress matrices (a) 17 1, (b) Solid lines are 
struts and dashed lines are cables 

eigenvalues and eigenvectors that yields tensegrities with minimal number of edges. However, as 
the above example illustrates, it may be possible to manipulate the choices of D and A to reduce 
the number of connections in a tensegrity derived using our method. 

Our approach has significant advantages because it is systematic and smooth. We exploit this in 
Section [4| where we define a smooth parameterization of the control law (|9| , creating a systematic 
framework for smooth reconfiguration of tensegrity structures between arbitrary planar shapes. 



The choice of parameters ajj, lij and oJij as defined in Section 2.2 is crucial in defining this smooth 
parameterization. 



3 Stability Analysis 



In Section 2.2 we presented an augmented model for the forces along the edges of a tensegrity and 



a systematic method to determine the parameters of the model ([7| that make any desired shape in 



the plane an equilibrium of ([9j). We now prove for the parameters aij,lij,u>ij satisfying (12), that 
the equilibrium set [z*^] = ([q'^],0,0) of ([9| is locally exponentially stable. We first show that [q*^] 
is an isolated critical point of the potential V^(q) and [z^] an isolated equilibrium set of (j9|. We 
then prove local exponential stability for [z^] using the linearization of (|9|. 



With the parameters aij,lij and LOij satisfying (12), q*^ = (x^,y^) is a critical point of the 



potential V{q). The potential V{q) only depends on the relative distances between the nodes. 
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This implies that V{c[) and hence the Lagrangian of the system are invariant under the action of 
the Lie group SE(2) on the configuration space Q. Given these symmetries, critical points of V^(q) 
and hence equilibria of (|9| are only isolated modulo SE{2) transformations. We now show that [q*^] 
is an isolated set of critical points of V^(q) by computing 5'^V{({) and proving that when the second 
variation of V^(q) is evaluated at q*^, we have a positive definite matrix except in the symmetry 
directions SE{2). 5'^V{cf) is given by 



(17) 



where O is the stress matrix derived in Section 2 and the ijth element of each block matrix is 



Lu)x{i, j) 



N 



if z / j 
11^ ifi=j 



L^y{i,j) = < 



-Q-ijUJij p 

ij 

N 



if i / j 
if z = i 



and 



Luixyihj) — ' 



N 



I] 



{xi—Xj){yi—yj)lij [f^ — j 



Lemma 3.1 (5^y(q^) is a positive semi- definite matrix. 
Proof: See proof in Appendix \K\ 
Lemma 3.2 The kernel of 6'^V{cf) is equal to 

span < 

Proof: See proof in Appendix |Bj 

Theorem 3.3 [x^] = ([q'^],0,0) is an isolated equilibrium set of 
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< 


(')■ 


{A 


{-A\ 








[-)\ 



are 



Proof: By Lemma 3.2, three linearly independent eigenvectors for the three zero eigenvalues 

/ . \ / . \ / e 

y , , 

. These vectors correspond respectively to symmetries of trans- 











1^ 



lation along the x-axis and the y-axis and of rotation about the origin. In addition, Lemma 3.1 
guarantees that all other eigenvalues of 6^V{cf) are strictly positive. Combining Lemma 3.1 and 



Lemma 3.2 concludes the proof of the theorem. □ 

We note that the equilibrium [z^] is not necessarily a unique equilibrium. 

Theorem 3.4 [z^] = ([q*^],0,0) is a locally exponentially stable equilibrium set of 

Proof: We prove local exponential stability for the isolated equilibrium set [z^] using lineariza- 
tion of d9|. The Jacobian of ([9| evaluated at = (x*^, y*^, 0, 0) is 



Bg{z' 



( 



\ 



02. 



(18) 



where the vector field g represents the right hand side of (|9| . We show that this matrix is negative 
semi-definite and the three zero eigenvalues correspond to the symmetry directions SE(2). The 
linearization Dg{z^) can be written as 



/ 1x2 



( 1x2 



+ 



i5'V{c^-) 02. 



--: Bi + B2. 



\ 







2n 







2n 



By Lemma 3.1 B2 is negative semi-definite. To show that Bi is also negative semi-definite, we 
proceed to two changes of basis given by the following two invertible matrices: 



Pi 



P2 



(1 

\ 
( 



^.l2n 7;l2n 



V 

02n 



'2n 



2n 



2n 



1 a2t 
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The representation of Bi in the new basis is 



V 



02n 



J2n 



This matrix is negative semi-definite for all ly > y Amax('^^V^(q'^)), where Xmax (^'^^V^(q^)j is the 
largest eigenvalue of 6'^V{q^). We now show by direct computation that the zero eigenvalues 
correspond to the SE{2) symmetries: 



if and only if 



if and only if 



02n 




y 

Pa 

\PyJ 








Px 

Py 



\ 







( \ 


p 




Px 










\Py) 






\v 









M 






y 











1 




G span < 










Px 














\Py) 






\V 







□ 





V J 

Local asymptotical stability can also be proved using the total energy of the system as a Lya- 
punov function. In the next section we utilize the exponential stability result to present a time- 
dependent control law, defined as a parameterization of the control law used in ([9]), that enables a 
tensegrity to reconfigure itself between arbitrary desired planar shapes. 
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4 Change of Shape 

The resuhs from the previous sections give a framework that allow us to stabilize any planar 
formation by mapping each vehicle to a node of the tensegrity structure and controlling them 
with the forces induced by the tensegrity's edges modeled by ([7|. We now take this result a step 
further and present a control law for the nodes that enables a well-behaved reconfiguration between 
arbitrary shapes. The control law is designed so that the nodes follow a smooth path in the space 
of tensegrities. Given a desired starting and an ending shape [q^] and [q^], we design a smooth 
path in shape space [q^](t) such that [q'^](0) = [qg] and [q^](T) = [q^], and we develop a method to 
deduce the necessary variations of parameters aij (t) , kj (t) and ujij (t) to make a tensegrity follow 
that path in shape space. The smoothly time-varying parameters define a smoothly time-varying 
control law. We study the resulting controlled time-varying dynamical system and use results from 
Lawrence and Rugh [17J on nonlinear systems with slowly varying inputs to prove the system is 
well behaved. By well behaved we mean boundedness during the trajectory, i.e. ||[q](t) — [q^](i)|| 
is bounded for t G [0, r], as well as convergence to the final shape, i.e., [q](t) — > [q^] as t ^ oo. 

4.1 Parameterized Control Law 

Designing a path requires us to define pairings between the nodes of the initial configuration and 
the nodes of the final configuration. With an eye toward preventing collisions between vehicles and 
minimizing energy input to vehicles, we make a choice so that (1) the planned trajectories of any 
two distinct nodes do not intersect and (2) the planned total distance travelled by all the nodes 
is minimized. We propose a solution where each vehicle travels on a straight line. Because of the 
symmetry in the system, the configuration can drift (rotate or translate) and therefore we cannot 
guarantee collision avoidance and minimal energy consumption. However simulations in section 



4.3 show good performence of the system with the well designed shape tracking laws we are now 



presenting. 

Path planning: To plan a path, we select representative configurations qg E [qg] and q/ G [q^] 
that have the same centroid. We choose the orientations and the pairings between initial and final 
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nodes to minimize 

N 
i=l 

This choice minimizes the planned total distance travelled by all the vehicles and ensures that no 
planned trajectories intersect. 

Lemma 4.1 A pairing, such that the trajectories of two nodes cross, does not minimize the total 
distance travelled by all the nodes. 

Proof: Consider any two nodes i,j of the initial configuration and suppose they are paired with 
two nodes i',j' of the final configuration. There are two possible pairings, either i is paired with 
i' and j is paired with j' or i is paired with j' and j is paired with i', as plotted in Figure [sj 
For the intersecting trajectories (dotted lines) the total distance travelled by the nodes is equal to 
&i + &2 + ^3 + ^4- For the non-intersecting trajectories (solid lines), the total distance travelled by 
the nodes is equal to 01 + 02 < ^'i + 62 + ^3 + &4) this from the triangle inequality. Hence if the chosen 
pairing of nodes have intersecting trajectories of any pair of nodes, the total distance travelled by 
all the nodes is not minimized. □ 




Figure 3: Two possible pairings between two starting nodes i,j and two ending nodes For 
the intersecting trajectories (dotted lines) the total distance travelled by the nodes is equal to 
^1 + &2 + ^3 + &4- For the non-intersecting trajectories (solid lines) the total distance travelled by 
the nodes is equal to 01+02 < 61 + ?*2 + &3 + ^4- 
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Given initial and final configurations qo and q/, we design a smooth path of tensegrities q'^(t) 
(x'^(t), y'^(t)) using the following linear interpolation: 



q'W = -q/ + (i--)qo, te[o,T] 

T T 

(fit) = q/, t> T. 



(19) 



The parameter r has units of time and allows for tuning of the tensegrity's reconfiguration speed. 
The greater r is, the slower the tensegrity reconfigures itself. The linear interpolation is an attractive 
choice of path, limiting the distance travelled by each vehicle and hence the energy required for the 
reconfiguration assuming no strong steady external forces. 

Control law: We now consider the following parameterization of the system Q: 



Xi =Pi 
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Vi = PI 
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Pi = -z^Pf 


-E 
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■y V 
Pl = -vpl 


-E 







kj{t) 

rij{t) 



{Xi Xj) 



iVt - Vj) 



(20) 



i = 1,...,N, where the parameters aij{t),lij{t) are to be designed so that the designed path 
[q'^](t) is a solution for t £ [0,r] and for fixed t £ [0,r] the corresponding equilibrium set [z^](t) = 
([q*^], 0, 0)(t) is exponentially stable. Following a similar procedure to the one developed in Section 
we pick the parameters aij{t),lij{t) and iOij{t) so that 



2.2 



0(t,x-(r),y-(T)) 

0(t,x^(r),y^(r)) 




0, tG[0,r] 



0, t>T, 



(21) 
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where the exphcit dependence on the first argument t in $7 comes from the dependence of on the 



parameters aij{t), lij{t) and ujij{t). As a first step to solve equation (21 ), we choose the parameters 



o:ij{t),lij{t) for all i,j so that Cl{-x'^(t),y^{t)) = This last equation is solved by setting 

'^ijW = 1 77\ 

arctanwioit , , 

' (22) 



arctanu;jj(i) I , 



where rfj{t) = \\q^{t) — qj{t)\\. Let r^{t) be the vector with elements r^j{t) strung together. The 



parameters uJij{t) are then computed as in Section 2.2 using the identity 



n{t) = A{t)DA{tf, (23) 

where D = diag ^0 ^4 • • • djy^ , di > 0, i = 4, . . . , N and the columns of A(t) constitute 
a basis of orthonormal eigenvectors obtained by the Gram-Schmidt procedure on N linearly inde- 
pendent vectors where x'^(t), y'^(t), 1 are the first three. This choice makes [q'^](t) a parameterized 



(by t) family of stable equilibrium sets for the system (20). We now use results from Lawrence and 



Rugh [T^ to show that the time- varying system (20) is well behaved. 



4.2 Boundedness and convergence 

Following the notations in jl7| . the following setting is considered: a system described by 

z(t) = /(z(t),u(t)), z(0) = zo, t>0, (24) 
where z{t) G M.^^ is the state vector, u(t) = {aij{t),lij{t),u!ij{t),r^j{t)) G is the input vector 



and / is the vector field given by (20). For such system, Lawrence and Rugh proved the following 
boundedness result [IT] : 



Theorem 4.2 Suppose the system (24) satisfies 
HI f : M^^ X R"" M^^ is twice differentiable, 

H2 there is a bounded, open set T C M™ and a continuously differentiable function z : T 
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such that for each constant input value u G F, /(z(u), u) = 0, 

H3 there is a X > such that for each u G F, the eigenvalues of (0//9z)(z(u), u) have real parts 
no greater than —A. 

Then there is a p* > such that given any p £ [0,p*] and T > 0, there exist 5i{p),52{p,T) > for 
which the following property holds. If a continuously differentiahle input u(t) satisfies u(t) G r,t > 

||zo - z(u(to))|| < 

and 



1 /■*+^ 

- J ||u(a) 1 1 dcT < (^2, t>to 



then the corresponding solution of (24) satisfies 



|z(t)-z(u(t))|| <p, t>tQ. 



To apply Theorem 4.2 to our system, we first show that ah three conditions H1-H3 are satisfied. 

The vector field ( |20[ ) is proved to satisfy HI by showing that Q.{t) and r'^(t) are smooth functions 
of t and that /(z(-),u(-)) is a smooth function of ^{■) and r^(-). The path of tensegrities q^(i) = 



(x'^(t), y'^(t)), given by (19 ) is a linear interpolation between qo and qj, and hence a smooth function 



of time. This guarantees smoothness for r'^(t). The time-varying stress matrix ^{t) is computed as 

= A{t)DA{tf, 

where Z? is a constant diagonal matrix and the columns of A(t) constitute an orthonormal basis of 
obtained through a Gram-Schmidt procedure on N linearly independent vectors x^(t), y'^(t), 1, 
W4(t), • • • , W7v(i)- The vectors obtained from a Gram-Schmidt procedure consist of linear combi- 
nations of the original set of linearly independent vectors, hence A(t) and consequently are 
smooth functions of t. We now show that /(z(-),u(-)) is a smooth function of and r'^(-). In 
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Section 2.2 we noted that the choice for the parameters Oij and lij given by 



vr 



arctan uJij 



lij = rfj I 1 arctan ujij 



is such that the vector field (|9| is a smooth map of ojij and rf-. Hence the vector field (20) is a 
smooth map of U,{t) and r^(t). This concludes the proof that the system (|20[) satisfies HI. 



We prove that (|20|) satisfies both H2 and H3 using the results from Section |3| By Theorems 3.3 

and 



3.4 we know that choosing the parameters Ojj, lij and LOij satisfying (|T2|) makes [z"^] an isolated 



exponentially stable equilibrium set of Hence choosing aij{t),lij{t) and oJij{t) satisfying (21) 
for every fixed t makes [z'^](t) an exponentially stable equilibrium set parameterized by 0(t),r'^(t), 



concluding the proof that (20) satisfies both H2 and H3. 

Theorem 4.2 guarantees that if we start "close enough" to [qg] (i.e., || [z](0) — ([qg], 0)|| < 5i) and 
the reconfiguration is not "too fast" (i.e., r large enough such that ^ //^"^ l|u((7)||dcr < 62), then 
the controlled reconfiguration is well behaved, i.e., ||[q^](i) — [q](i)ll is bounded and [q](t) [q^] 
as i — > 00. We next explore the performance of this control law with a simulation example. 

4.3 Simulations 



We present in this section simulation results for the reconfiguration control law given by (20). We 
investigate with an example the effect of the choice of r on the shape error and on the total distance 
travelled by the vehicles through the reconfiguration. Shape error e{t) is measured as 



N 

e{t) = Y,{diG{t) - dta{t))\ (25) 

i=l 

where dicit) (respectively d^g,(t)) is the observed (respectively planned) distance between the ith 
node and the center of mass of the formation at time t. 

We consider as an example the reconfiguration of a five vehicle formation from initial configu- 
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Figure 4: Plot of the planned initial and final configurations for the studied five vehicle formation. 
The initial configuration is convex but not strictly convex, while the final configuration is non- 
convex. 



ration qo to final configuration qj given by 



qo 



/ 

V 
/ 

V 



-2.6 
-1.2 



-.6 1.4 3.4 -1.6 
-1.2 -1.2 -.2 3.8 



-.4 -.9 1.1 1.1 - 

0-1-11 1 



plotted in Figure |4j where the coordinates are expressed in meters. The initial configuration is 
convex but not strictly convex and the final configuration is non-convex. 

Figure [5] shows the evolution of the mean total distance travelled by the five nodes calculated 
over five thousand runs as a function of r, for values of r between .1 and 10 with increment of .1. 
The greater r is (i.e., the slower the network is prescribed to reconfigure itself), the shorter the 
distance travelled by the five vehicles. The lower bound is given by the total distance travelled for 
the linear designed path (solid black line which gives 8.7m). 

Figure |6] shows for r = .Is, 1.3s and 3s a plot of the shape error as a function of time and 
snapshots of the five vehicle network at the beginning of the reconfiguration, at the first two peaks 
of the shape error curve and when the shape error becomes permanently smaller than 10^'^m. We 
note that the shape error graphs do not all have the same scale. Looking at the graph of the shape 
error for the cases r = .Is and r = 3s, we observe a difference of two orders of magnitude. The 



25 



Total distance versus r 




Figure 5: Evolution of the mean total distance travelled by the five nodes calculated over five 
thousand runs (each run for 500s) as a function of r, for values of r between .Is and 10s with 
increment of .1. The lower bound is given by the total distance travelled for the linear designed 
path (solid black line which gives 8.7m). 

case where r = .Is is so fast that it is close to the case in which no intermediate points on the 
path are given but rather the system is required to stabilize to the final configuration given the 



initial configuration as initial condition, as in Section 2.2 Looking at the snapshots at the peak of 
shape error for the case r = .Is we see that these peaks can be interpreted as overshoots. Indeed 
the network over-shrinks at first but then over-extends whereas in the r = 3s case, the structure 
follows more smoothly the prescribed path. Likewise, the r = .Is case takes the longest to converge 
and the r = 3s case takes the shortest time to converge. We also note in these snapshots that, 
independent of the choice of r, the structure at its final configuration is rotated; this is due to 
changing total angular momentum of the system. It highlights the fact that we are only controlling 
the shape of the structure but not its position and orientation. 



5 Final Remarks 

We have presented and proven a methodology that provides distributed control laws that stabilize 
a multi-vehicle formation for an arbitrary planar shape. The results extend to changes of formation 
shape over a given time interval. A key idea is to model the controlled multi-vehicle dynamics as a 
tensegrity structure with nodes representing vehicles and forces along struts and cables representing 
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Figure 6: For r = 0.1s, 1.3s and 3s, shape error is plotted as a function of time. (a)-(c)-(e) give the 
snapshots of the five vehicle network along the prescribed path respectively for r = 0.1s, 1.3s and 3s. 
(b)-(d)-(f) give actual snapshot of the five vehicle network at the beginning of the reconfiguration, 
at the first two peak of the shape error curve and when the shape error becomes permanently 
smaller than 10~'^m respectively for r = 0.1s, 1.3s and 3s. 
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interconnecting vehicle control forces. Critical to the result is the smooth map we derive from 
arbitrary planar shape to a parametrized tensegrity structure. 

It is a limitation, however, that given an arbitrary shape, our map often yields a tensegrity 
structure with number of interconnections greater than the proven lower limit. We showed with an 
example how to manipulate our method to reduce the number of interconnections; however, future 
work will examine making such a modification systematic. 

Since our stability results are local, it is of interest to consider proving more global results 
and exploring the global phase space to better leverage dynamics of tensegrity structures; for 
example, see [18] for interesting, possible periodic solutions. In [19] we prove global results for 
one-dimensional tensegrity structures and use this to prove global stability of planar and three- 
dimensional shapes by creating two and three-dimensional structures made up of a set of orthogonal 
one-dimensional tensegrity structures. In future work we will consider extending the method of the 
present paper to three dimensions to provide a compelling, alternative means for controlling the 
shape of three-dimensional formations. 
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A APPENDIX 



In this appendix, we present the proof of Lemma 3.1 We write 5 V{c^) as 



5^V{(f) = Ml + Ma := 





Otv^ 




(l L \ 










i 







Recall that 17 is designed to be positive semi-definite, hence Mi > 0. We show M2 positive semi- 
definite. By direct computation. 



T T 



(l l ^ 

^ux ^ujxy 
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^^u)xy ^tjjy J 







^.X Lu)X^X + ^.y Li^yC[y -\- 2q^ L^xy^ly, 



(A-1) 
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where qx = {Qxi ■ ■ ■ Ixm) ^ > ^^^1 = {qy^ ■ ■ ■ qy^^) G M . Each term of the sum can be 
rewritten as 

N N ( _ \2i 

^ij^ijy^i ^j) 



^.x^t^x^x — Qx, {Qxi — Qx 

«=i j=i jV* 



E 



3 '^^j' ' 

i<j V 

N N r \2j 
% ^ujy'iy - 2^ %i ^ Vlvi - Qvj ) 

«=i j=i jy* 

J^ujxyCiy - Qx^ ^3 [Qyi " % j 



~ -^3 \yi ~ 9] ''11 r \r X 

—{Qy. - Qy,){Qx, " 



( A-1 ) can now be factored as 



(^L^x^x + ^jLuyfiy + 2q^L^xy(ly = ^'^^^^^'^ {{vi - yj){qy, - qy^) + {xi - Xj){qx, - qxj)^ > 0. 

i<j ^ij 

(A-2) 

This concludes the proof that M2 > 0, and hence 6'^V{q^) > □ 



B APPENDIX 



In this appendix, we present the proof of Lemma |3.2[ By Lemma 3.1, Mi and M2 are sym- 
metric, positive semi-definite matrices. Hence, 

q G ker(5V(q'^)) ^ q G ker(Mi) and q G ker(M2). (B-1) 

By design, ker(Mi) = {wi,W2,W3}; by direct computation, we check {wi,W2,W3} G ker(M2). 



Using (B-1 1, we conclude that the kernel of J^y(q'^) is exactly spanned by {wi, W2, W3}. □ 
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